/*
 * Motor_Test.c
 *
 *  Created on: Feb 2, 2017
 *      Author: YzZe
 */

#include "Motor_Test.h"


void Motor_test_vTask(void *pvParameters)
{
	portTickType xLastWakeTime;
	xLastWakeTime = xTaskGetTickCount();


	for (;;)
	{
		Motor_Left_Ahead(200);
		Motor_Right_Ahead(200);

		vTaskDelayUntil(&xLastWakeTime, (100 / portTICK_RATE_MS));

		Motor_Stop();
		Motor_Left_Back(200);
		Motor_Right_Back(200);
	}
}
